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(57) A feedback control system which includes a 
disturbance estimator and controller which takes ac- 
count of and corrects for non-linear disturbances. A sim- 
ple state model representative of the controlled plant is 
provided. A plant controller responds to a command sig- 
nal and a process feedback signal for producing a con- 
troller output. The controller output drives both the plant 
and the state model. A sensed signal representing a 
state of the plant is compared with a corresponding out- 
put state of the model to produce an error signal which 
is representative of disturbances applied to the system. 



The disturbance estimator and controller responds to 
the error signal to produce a disturbance control output 
which is adapted to compensate for the non-linear dis- 
turbance, in a preferred embodiment the plant is an ac- 
tuator and the non-linear disturbances are friction relat- 
ed. The disturbance control output in the preferred em- 
bodiment has an initial constant magnitude summed 
with an increasing ramp, and the disturbance estimator 
senses polarity reversals in the error signal to reverse 
the polarity of at least the constant component of the 
disturbance output. 



CM 

< 

CM 
CM 

LO 
CO 

o 
Q. 

LU 



61o. 



31- 



^10_ 



CONTROL COMMAND 



30 



32 



55 



PLANT 



61 



60 



DISTURBANCE 
ESTIMATOR/ 
CONTROLLER 



56a 



K/x 



CONTROL 



-30a 



V46 



41 



T 



FIG. 2 



42 



40 



ACTUATOR 
MODEL 



•56 



■43 



Printed by Jouve. 75001 PARIS (FR) 



BNSOOCID: <EP__0845722A2_I_> 



1 



EP 0 845 722 A2 



2 



Description 

Field Of The Invention 

This invention relates to closed loop feedback con- 
trol systems, and more particularly to control systems 
adapted to take account of "disturbances", particularly 
non-linear disturbances. 

Background Of The Invention 

Feedback control systems are well known and have 
many practical uses. They can be very simple, or they 
can be quite sophisticated and complex. Many have an- 
alog or digital computers used to perform the control 
function, have sensors for sensing process or plant con- 
ditions, and have outputs for controlling the process or 
plant. Most broadly, a feedback control system can be 
thought of as having a command input, a feedback (or 
plant) input, control elements for sensing the relation- 
ship between command and the feedback signals and 
producing a controller output in accordance with the er- 
ror between those signals, for controlling the process. 
Feedback control systems can be as simple as the ther- 
mostat in a home heating system. In the automobile both 
the cruise control and the anti-lock braking system can 
include closed loop feedback control systems. 

The present invention deals with reasonably so- 
phisticated control systems which, in addition to re- 
sponding to command and feedback signals to produce 
a controller output as a result of differences between the 
command and feedback signals, are subjected to and 
are intended to compensate for non-linear "disturbanc- 
es". A significant application for such control systems is 
for fuel control valves (or injector valves) for large indus- 
trial engines, such as turbines or multiple cylinder inter- 
nal combustion engines. In such systems an actuator 
position is controlled to a particular point to allow fuel to 
flow at a particular rate, and the feedback system will 
sense an engine parameter (such as RPM, for example) 
and compare that with an input command signal to main- 
tain the position of the actuator at a point which will min- 
imize the error signal. Most often, except for transient 
conditions, the valve is stationary. If an adjustment is 
required the control system must produce a signal to 
drive the valve to its new position. However, friction 
comes into play, and it is known that before the valve 
begins to move, a force must be applied which is ade- 
quate to overcome static friction. That force is typically 
significantly greater than the force it would take to simply 
move the valve to its new position if friction were not 
present. Sliding friction forces must also be overcome 
when the valve is moving, it is these types of friction 
effects which can be considered non-linear disturbanc- 
es in this example. 

It will be noted at this point that friction is not uni- 
versally considered to be a disturbance by all. However, 
in feedback control system such as those disclosed in 



the present application, it is a useful concept for control 
purposes. Accordingly, friction will be treated as a dis- 
turbance, and in the preferred embodiment, the distur- 
bance of interest in this application. 
5 Those skilled in the art will appreciate that the dis- 
turbance signal can be ignored and ultimately with a 
properly configured control loop, the control and feed- 
back signals will ultimately drive the system to the de- 
sired position, but commonly with limit cycles due to fric- 
io tion. However, that is only acceptable in system which 
can tolerate slow response times. When a highly re- 
sponsive control, which has a fast response time and 
resulting high bandwidth is required, it is not acceptable 
to simply ignore the disturbance signal and allow the dis- 
is turbance to be subsumed in the control. That will typi- 
cally lengthen response times to beyond acceptable lim- 
its. Instead, steps must be taken to somehow compen- 
sate or make provision for the expected non-linear dis- 
turbance. This is preferably done in a way which does 
20 not hinder overall system performance and response 
time, and also in a way which does not detrimentally af- 
fect the stability of the system. 

In the past, "dither" techniques have been used in 
an effort to deal with disturbances such as these. A dith- 
25 er signal is a noise signal, e.g. a square wave or pulse 
signal which is injected into the system in an effort to 
"overpower" the disturbance signal, and thus its effect. 
The magnitude of the dither signal is great enough to 
overcome the friction. The effect of the dither is to con- 
30 tinuously oscillate the output signal so that the actuator 
is being driven (only a minuscule amount) in one direc- 
tion or the other, such that if an error signal requiring 
valve movement is produced by the controller, the dither 
will have already overcome static friction. This tech- 
35 nique has a number of disadvantages. The dither is, of 
course, non-adaptive, and thus the magnitude must be 
set to a level higher than the largest disturbance intend- 
ed to be encountered. In the friction example, it must be 
set higher than the highest level of friction which the sys- 
40 tern is expected to encounter. Furthermore, friction is a 
varying non-linear force, and the dither does not have 
the ability to adapt to the differing friction levels. Conse- 
quently, the use of a dither approach may provide too 
much or too little force to overcome the f rictiona! forces. 
45 in addition, the dither reduces system robustness, 
through excitation of system resonances : or by making 
the control response less determinant. 

Suggestions have been made as to adaptive ways 
of handling disturbances when disturbances are of the 
50 linear variety. However, when the disturbances become 
non -linear, resort has been had to other techniques, 
such as the use of the dither, in order to approach ac- 
ceptable system response times and steady state per- 
formance. 

ss 

Summary Of The Invention 

In view of the foregoing, it is a general aim of the 
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present invention to provide a feedback control systems 
which estimates and accounts for non-linear system dis- 
turbances, as opposed to simply attempting to overpow- 
er the non-linear disturbances. 

In accomplishing that aim, it is an objective of the 
present invention to provide a control system having an 
estimator or observer to determine the onset of a non- 
linear disturbance, and to provide an output signal of a 
magnitude able to compensate for the non-linear distur- 
bance. 

In an particular implementation, it is an object to pro- 
vide a control system for use with an actuator which 
takes account of non-linear disturbances in the actuator, . 
including static and sliding friction, and, upon the occur- 
rence of such disturbances, to modify the control signal 
to account for and minimize the effect of such distur- 
bances. 

It is a resulting object to provide a closed loop feed- 
back control system which is highly responsive, which 
enhances its response lime by estimating for and con- 
trolling non-linear disturbances, and which accomplish- 
es that in a way which does not adversely impact system 
robustness or stability. 

In a certain respect, it can be considered an object 
of the present invention to provide the effect of an adap- 
tive dither for certain types of control systems. 

In accomplishing these aims and objectives, the 
present invention provides a system and corresponding 
method which accomplishes closed loop control of a 
plant in which a plant controller responds to command 
inputs and feedback inputs for producing a controller 
output, and which takes account of non-linear distur- 
bances in a particularly effective way. A state model is 
provided which is broadly representative of the plant, 
and which is driven by the controller output. A compa- 
rator compares a signal representative of an operating 
condition of the plant with a corresponding operating 
condition of the state model to produce an error signal 
representative of the differences. For example, a posi- 
tion signal from the plant and a state output from model 
representative of position are compared to detect differ- 
ences between the plant and the model. A disturbance 
estimator and controller is responsive to the error signal, 
for producing a disturbance controller output signal 
which is of a pre-determined magnitude based on 
known non-linear characteristics of the disturbance. 
Means are provided for coupling the disturbance con- 
troller output as a supplemental input lo the plant lo com- 
pensate for the non-linear disturbance. 

In the particular situation where the disturbance of 
interest is friction, the disturbance estimator and con- 
troller produces a two level output including a first con- 
stant component which is slightly less in magnitude than 
the minimum level disturbance known to exist in the sys- 
tem. A second component is a ramp added to the con- 
stant component so that the sum of those signals quickly 
causes the system to progress through the non-linear 
disturbance. The error signal indicates such as by re- 



versing polarity, the point at which the output progresses 
through the disturbance whereupon the disturbance 
controller output also reverses. 

It is a feature of the invention that the disturbance 

s estimator and controller adds a compensating signal to 
the plant control signal of a magnitude adequate to com- 
pensate for non-linear disturbances, and which contin- 
ues to reverse polarity about a control point. The system 
is configured in a preferred embodiment to produce a 

10 very small limit cycle on the actuator output so that f ric- 
tional effects are readily overcome but without the det- 
rimental result of excessive wear and motion on the ac- 
tuator. 

It is a further feature of the invention that a very sta- 
is ble and linear control can be provided and which is over- 
laid with a non-linear disturbance estimator and control- 
ler in a way which does not affect the robustness of the 
underlying linear control. 

According to certain aspects of the invention, it is a 
20 feature that the basic plant control is optimized for plant 
conditions, and the non -linear disturbance estimator 
and controller is configured to account for very small ac- 
tuator movements and very small errors introduced by 
non-linear disturbances without affecting the overall ro- 
2S bustness. of the basic plant control loop. 

Other objects and advantages of the invention will 
become more apparent from the following detailed de- 
scription when taken in conjunction with the accompa- 
nying drawings. 

30 

Brief Description Of The Drawings 

Figure 1 is a schematic block diagram representa- 
tion of a conventional PI D feedback control system 

35 with a dither module to overcome disturbances; 

FIG. 2 is a block diagram representation of a feed- 
back control system implementing the disturbance 
estimator and controller according to the invention; 
FIG. 3 is a block diagram, similar to FIG. 2, but il- 

40 lustrating an alternative implementation of the 
present invention, showing a different connection of 
a disturbance estimator and controller in a control 
system, and illustrative of the breadth of the present 
invention; 

45 FIG. 4 is a second order state model of an actuator 
system with control; 

FIG. 5 is a schematic block diagram representation 
of a disturbance estimator and controller according 
to the invention; 
50 FIG. 6 is a schematic block diagram representation 
of a more complex disturbance estimator and con- 
troller according to the invention. 

Detailed Description Of The Preferred Embodiment 

55 

The present invention will be described specifically 
in the context of a feedback control system for an actu- 
ator in which the non-linear disturbance to be compen- 
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sated are the friction forces associated with the actuator. 
However, the description will also characterize the in- 
vention more broadly as adaptable to feedback control 
systems in general which are subject to non-linear dis- 
turbances, and in which means are provided for estimat- 
ing and controlling the effect of such non-linear distur- 
bances. Thus, while the actuator implementation is the 
currently preferred embodiment, it is believed that the 
invention has broader aspect, and it is the intention to 
cover all alternatives and modifications of the present 
invention, both narrowly and broadly, as are encom- 
passed within the spirit and scope of the invention as 
defined by the appended claims. 

Turning then to the drawings, in order to provide 
context for the present invention FIG. 1 illustrates a 
schematic block diagram of an actuator using a conven- 
tional PID control: with a dither toovercome friction forc- 
es. According to this conventional design, acontrol com- 
mand input 1 0, for example a position command signal, 
is connected as an inpul to a standard proportional, in- 
tegral, and derivative (PID) controller 12. Following 
standard feedback control techniques, the PID control- 
ler 1 2 also has a feedback signal relating to the actuator 
position as a feedback input on line 24. The output 13 
of the PID controller 1 2 is coupled to a P, PI, or PID con- 
troller 1 4 depending on system performance criteria and 
characteristics. The P, PI, or PID controller 14 also has 
a feedback signal, in this case relating to the actuator 
velocity, as an input on line 22. 

In an ideal world, i.e., one without disturbances 
such as friction, the output 15 of the P, PI, or PID con- 
troller 14 would directly be coupled to the system plant 
20 to drive the actuator to the desired position. In real 
world implementations of feedback control systems, 
however, disturbances such as friction are always 
present and interfere with system performance. To pro- 
vide sufficient force to overcome the friction forces act- 
ing on the system, a dither signal source 16 produces a 
dither signal which is added to the signal 1 5 in a summer 
18, and the resulting signal 19 is the one that is coupled 
to the plant 20. 

The overcoming of friction including static friction 
can be conceptualized in the following terms. Assume 
that the command signal and feedback signal are such 
that a change in the output is required, and the system 
is a high performance system with fast demanded re- 
sponse time. The mismatch in command and feedback 
signals will produce an error signal of a given magni- 
tude. If the system is already moving in the direction de- 
manded by the error signal, the error signal will be ca- 
pable of driving the plant within the design parameters 
of the systems to the newly required position. However, 
if the plant is at rest, and static friction or some other 
disturbance is a factor, the error signal will not be of suf- 
ficient magnitude to drive the plant to the new position 
within the required response time. Response and limit 
cycle will thus be much more sluggish, and a major part 
of the reason is the friction or.the disturbance. In the 



case where it is necessary to overcome static friction in 
order to get the system in motion, the dither approach 
has utilized a dither signal to keep the system just over 
the edge of movement in order to compensate for static 

s friction. If the motion is too great, the plant (for example 
the actuator and its seals and bearings) can be subject- 
ed to excessive wear, and oscillations, and system per- 
formance might also be compromised. If the dither sig- 
nal is not of great enough magnitude, part of the distur- 

io bance will not be overcome. In any event, it is difficult to 
achieve and maintain a consistent level which will pro- 
vide the desired performance, and the systems are gen- 
erally a compromise, often less than satisfactory. 

There are many reasons why a dither is not an ideal 

1$ solution to controlling disturbances such as friction. 
First, friction is a varying, nonlinear force. The dither sig- 
nal, however, is usually a constant square wave or pulse 
type signal. Because the dither is non-adaptive, at var- 
ious times it may provide too much or too little force to 

20 overcome friclion. Further, the dither reduces system ro- 
bustness. As a result, the system loses the ability to per- 
form consistently despite changing parameter values, 
e.g., friction, applied voltage, flow forces, etc. 

FIG. 2 is a block diagram of a control system for an 

25 actuator, the system incorporating a disturbance esti- 
mator and controller according to the invention. In con- 
trast to a PID-based control, as in FIG. 1 , FIG. 2 illus- 
trates the use of a state space controller. A control com- 
mand 10 is provided which is a source of command sig- 

30 nals for the controller. In the case of the actuator, the 
command signal will typically be a position command. 
The position command is coupled to a controller 30. The 
controller 30 also has a feedback signal provided on line 
41 . In this case, however, the feedback signal is from a 

35 model 40, rather than from the plant itself. 

In carrying out the invention, an actuator model 40 
is provided which broadly can be characterized as a 
state model of the system or plant to provide output sig- 
nals which are estimates of the states of the systems. 

40 in the present instance, the output 41 taken from the 
model 40 is intended to be position output, which is cou- 
pled back to the controller 30 for comparison with the 
position command signal 10 to produce a controller out- 
put signal 46. 

45 in the FIG. 2 implementation, the controller output 
signal 46 directly drives the actuator model 40 and by 
means of a scaling element 30a produces an output sig- 
nal 31 which is coupled to the plant 55 as a main con- 
troller output signal for the plant. Thus, and ignoring the 

so disturbance estimator and controller elements for the 
moment, the main control 30 responds to control com- 
mands for module 10 and feedback signals on line 41 
to produce a controller output signal on line 46 which 
controls the position of the plant 55. In the present ex- 

ss ample, the plant 55 is the actuator, and it is the position 
of the actuator which is controlled. 

In accordance with the invention, an output of the 
plant 55 and state output of the actuator model 40 are 
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compared in a comparator 56a to produce an error sig- 
nal on line 42. The position signal on line 56 is typically 
taken from a transducer (such as a synchro) which 
measures actuator position, and thus is an actual meas- 
ure of the controlled output. The signal on line 43 is an 
estimate of the position state taken from the model 40. 
Differences between those signals can be attributed to 
disturbances such as friction, and the polarity and mag- 
nitude of the signal on line 42 can be sensed to estimate 
the presence of a disturbance and to control for its effect. 
To that end, and in accordance with the invention, a dis- 
turbance estimator/controller 60 is coupled to the com- 
parator 56a to sense the signal on line 42 and to provide 
an output signal adapted to compensate for the distur- 
bance. The output signal is provided on line 61 and is 
combined with the controller output on line 31 in summer 
61a to produce an output signal 32 which drives the 
plant 55. 

The output signal and line 61 is not a linear function 
of the error signal on line 42, nor is it a function which 
varies linearly with respect to time. Instead, the signal 
produced by the controller 60 is adapted to compensate 
for the non-linear characteristics of the disturbances. As 
will be described below, in a currently preferred embod- 
iment of the invention, the disturbance output signal 60 
is in the form of a two level signal including a step func- 
tion having a magnitude which is slightly less than the 
smallest disturbance expected to be encountered, 
summed with a ramp signal of a magnitude adapted to 
progress through the disturbance level. The intercon- 
nection of the elements as illustrated in FIG. 2 is adapted 
to continuously monitor the error signal which is a meas- 
ure of the difference between the plant 55 and the ac- 
tuator state model 40, and to reverse polarity as the out- 
put signal from the disturbance controller the distur- 
bance signal. Upon reversal of polarity, the disturbance 
estimator and controller will drive the system in the other 
direction until the comparator again senses that one has 
passed the other. The system will continue to alternate 
conditions in this fashion, and the parameters are such 
that the movement about a steady state point is very 
small, and within a tolerable limit cycle. 

The disturbance estimator and controller 60 uses 
the error signal on line 42 to estimate the disturbance 
acting on the system, and to generate the force neces- 
sary to counteract the disturbance. The error signal is 
determined by comparing the actuator position signal on 
line 56 Irom and the model actuator position state on 
line 43. The counterlorce generated by the disturbance 
estimator and controller 60 is added to the compensator 
signal 31 to generate a control signal 32. Control signal 
32 is the signal that drives the actuator 55. 

In the FIG. 2 implementation, the composite signal 
32 which includes both a controller input and a distur- 
bance estimator/controller input drive the plant 55, but 
only the controller signal 46 is coupled to the model 40. 
In order to assist the model 40 in following the actuator 
55, the error signal 42 which is derived from the compa- 



rator 56a is also connected as an input to the actuator 
model 40. The specific manner in which this can be ac- 
complished is described below. For the moment, it is ad- 
equate to understand that the connection of the error 
s signal to the model assists the model in the following the 
plant and thus to assist the overall control. 

Turning now to FIG. 3, there is shown an alternative 
implementation of the invention, at about the same level 
of detail as FIG. 2. FIG. 3 illustrates a separate distur- 
10 bance estimator and disturbance control, and their in- 
terrelationship to the remainder of the system. As in the 
FIG. 3 implementation, a main controller 30 has inputs 
from a control command module 10 and an actuator 
model 40 including a system state signal on line 41 , typ- 
is ically representative of position. The controller 30 pro- 
duces an output signal 46 which ; in this instance is 
passed through a summer to produce a composite sig- 
nal on line 32 which drives both the actuator model 40 
and the actuator 55. A plant feedback signal on line 56 
20 and a model state feedback signal on line 43 are cou- 
pled to a comparator 56a to produce an error signal 42. 
As in the prior embodiment, the error signal 42 is a 
measure of the disturbance, and is coupled to the input 
of the disturbance estimator and controller. However, in 
25 the present case the disturbance estimator and distur- 
bance controller are separate elements. The distur- 
bance estimator is illustrated as block 60a, and provides 
an output signal which is coupled to the disturbance con- 
troller 60b and also coupled to the actuator model 40. 
30 The disturbance estimator, the in the case of certain ac- 
tuators, can consist of simply a comparator and an in- 
tegrator adapted to mimic friction effects. The integrated 
output signal is then passed to the disturbance controller 
60b which produces an output signal coupled to the 
35 summer for supplementation of the controller signal 46 
so as to overcome the disturbance. The composite sig- 
nal on line 32, in this case is coupled to drive both the 
model 40 and the actuator 55. 

In certain cases the disturbance estimator 60a and 
40 controller 60b can be combined into a single module. 
This is particularly the case when the front end dynamics 
can be approximated by a simple function, such as a 
constant, in which case the estimator and the controller 
become the same elements. However, as illustrated in 
45 FIG. 3, when the estimator is a more complex element, 
separate estimator and controller modules can be pro- 
vided to accomplish the aims of the present invention. 

Particular forms of the disturbance estimator and 
controller of the invention are discussed more particu- 
so larly in reference to FIGs. 5 and 6. To utilize the distur- 
bance estimator and controller of the invention, one first 
needs to design and build a model of the system in ques- 
tion. A very simplified state model is usually adequate, 
as will be described below. The system model is then 
ss used to obtain system states and to compare act ual sys- 
tem performance to the model performance. 

Referring to FIG. 3, in the present embodiment of 
the invention, the actuator 55 can be adequately mod- 
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e led and represented by a second order state diagram. 
The actuator model 40 includes two serially connected 
integrators 47 and 45. Feedback signals on lines 44 and 
43 represent velocity and position states, respectively. 
It will thus be appreciated the state model 40 is a rather 
simple implementation, and only roughly characterizes 
the state of the system. However, when used as taught 
the present specification, the model 40 is adequate to 
provide a sufficient indication of actuator states to be 
used with the control system and with the disturbance 
estimator and controller to provide precise feedback 
control of the actuator. 

The remaining elements illustrated in FIG. 3 are 
representative of the control elements. The summer 48 
combines the command signal 10, the position feedback 
signal from the model on line 43 and, in the present 
case : a scaled function of the velocity state on line 44. 
The output signal 49 of the summer 48 operates through 
a gain element 49a to produce an output signal on line 
46 which drives both the model 40 and the plant (not 
illustrated in FIG. 3). The gains are determined in part 
by normalization, and in part by the desired dynamics 
of the system. For example in FIG. 3, the gain K c1 and 
K c2 establish the system dynamics. For example, K c1 
and K c2 are determined from an evaluation of the ex- 
pression: 

G(s)=1/(S 2 /K e2 + S*K c1 +1) 

With that as background, and turning now to FIG. 

4, there is shown a simplified implementation of a control 
system constructed in accordance with the present in- 
vention. An actuator model 40 is provided which in- 
cludes integrators 47 and 45 connected to provide a 
simple state model of the system. In order to renderthat 
model somewhat more representative of the system, the 
input signals through the integrators 47 and 45 are sup- 
plemented as described below. Thus, as shown in FIG. 

5, instead of directly connecting the controller command 
on line 46 into the first integrator 47, that signal is sup- 
plemented is by a signal on line 53 taken from the error 
comparator 56a. A signal 53 is summed with the signal 
46 in a summer 50 to produce an output signal on line 
54 which serves as an input for the first integrator 47. 
The signal on line 53, in turn, is representative of the 
error signal on line 42 multiplied by a gain constant K^. 
The gain K e1 is explicitly determined by establishing po- 
sition bandwidth. Indeed, FIG. 6 illustrates both the gen- 
eral constants and the more detailed elements which 
determine the constants. One of ordinary skill in the art 
will readily appreciate how one determines the con- 
stants based on the bandwidth and factors specified 
above. 

As a further refinement of the system of FIG. 5, in- 
stead of driving the second integrator 45 in the model 
from the output of the velocity determining integrator 47, 
the input signal 44 is supplemented by a further signal 
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52 taken from the plant. Thus, a summer 51 receives 
signal 44 from the integrator 47 and a further signal on 
line 52 from a gain element 52a which has the error sig- 
nal 42 as an input. The gain Ke2 of the element 52a is 
$ explicitly determined based on the same variables and 
methods as the gain K eV In this manner, the actuator 
model 40 is made to more accurately predict the oper- 
ation and states (e.g., velocity and position) of the actu- 
ator 55. 

10 One embodiment of the disturbance estimator and 
controller 60 of the invention will now be discussed in 
greater detail. In the illustrated embodiment, use is 
made of hysteresis switches 69, 65 for providing current 
signals which are summed with the controller output to 
15 produce a composite drive for the plant. Those switches 
are used in combination with a disturbance integrator 
72 and when utilized as described will tend to produce 
enough force to overcome friction as quickly as possible 
but without adversely effecting system performance. 
20 The oulput of hysteresis switch 65 serves as a direct 
input to a summer 75 which provides a composite signal 
on the output line 32 which is connected to the actuator 
for driving the actuator. The error signal also triggers a 
second hysteresis switch 69 which drives an integrator 
25 72 to produce a ramp signal which supplements the dis- 
turbance control signal on line 66. The effect is to pro- 
duce a composite signal which is summed with the con- 
troller signal 31 to overcome the disturbance. 

The hysteresis switches 65, 69 produce output sig- 
30 nals which are of a predetermined magnitude and inde- 
pendent of the magnitude of the input error signal 42. 
Thus, when the error signals switches to a particular po- 
larity the hysteresis switch 65 will produce an output sig- 
nal of a given magnitude. In the illustrated embodiment, 
35 the output signal of the switch 65 is of a constant level 
and having a magnitude which is just very slightly less 
than the minimum disturbance known to exist in the sys- 
tem. That step function is supplemented by a ramp pro- 
duced through the hysteresis switch 69 and disturbance 
40 integrator 72. The ramp adds an increasing ramping sig- 
nal to the constant signal 65 which will quickly push the 
composite signal through the disturbance. As a result, 
the current signal 32 which is coupled to the actuator 
has three components — the main controller component 
45 on line 31 , the minimum valve set magnitude on line 66 
and a ramp signal on line 73 which will combine to com- 
pensate for the disturbance. The disturbance is "esti- 
mated 0 in the sense that the outpul of the plant and the 
output of the model are continually monitored by the 
so comparator 56a and when the plant signal passes the 
signal from the model, the reversal will be determined 
by the comparator 56a which will reverse the polarity of 
the error signal 42. That will be immediately sensed by 
the hysteresis switches 65, 69 which will change their 
ss polarity and attempt to drive the actuator in the other 
direction. This alteration of the polarity of the error signal 
on line 41 and the polarity disturbance control signal 
coupled to the summer 79 will continue. The gains are 



EP 0 845 722 A2 



BNSDOCID: <EP_0845722A2_L> 



V 



11 



EP 0 845 722 A2 



12 



such that the movement about an established point is 
very small, although the magnitude of the disturbance 
control signal is adequate to push the system through 
the disturbance. 

The degree of "oscillation" about a stable point is 
sometimes characterized as a "limit cycle", it is a gen- 
eral design and performance goal of feedback control 
systems to minimize the limit cycle, or at least maintain 
it within an acceptable zone. What is considered an ac- 
ceptable zone depends on the system. For example, 
with the GS10 and GS25 actuators (see below), the 
seals of the actuator are capable of a certain amount of 
flex. If the limit cycle of the actuator can be maintained 
within the flex region of the seals, then the wear and tear 
on these actuator components will be minimized and the 
actuator life is extended. Similarly, minimizing actuator 
movement about the steady state output minimizes 
wear and tear on other actuator components, e.g. the 
actuator bearings. Maintaining an exceptionally small 
limil cycle (commonly in the range of 0.02°) will tend to 
minimize actual error movement occasioned by the dis- 
turbance estimator and control system, so as not to ad- 
versely wear seals or bearings of the actuator. At the 
same time, when movement of the actuator is desired, 
the of friction disturbance is readily accounted for in a 
highly responsive and accurate result. 

As discussed in detail below, the hysteresis switch 
65 produces a constant force component 66, and the 
integrator 72 produces a force component 73 in the form 
of a ramp. Force components 66 and 73 are added to 
the compensator signal 31 at summation point 79 to ob- 
tain the control signal 32 which is inputted into the ac- 
tuator 55 (not shown). 

Control signal 32 will have sufficient current to over- 
come friction forces and drive the actuator 55 to the de- 
sired location. Because of the ramp force component 
73, however, the control signal 32 will eventually have 
too much current and cause the actuator to slightly over- 
shoot the desired steady state location. Once the actu- 
ator 55 (not shown) has passed the desired location, 
however, the sign of the error signal 42 changes. When 
the sign of the error signal 42 changes, the sign of the 
output of the hysteresis switches 69 and 65 will also 
change, causing the force components 66 and 73 to be 
exerted in the opposite direction. The actuator will then 
be driven in the opposite direction to reach the desired 
steady state location. Because of the ramp force com- 
ponent 73, however, the actuator will once again slightly 
overshoot the desired steady state location. The over- 
shoot will cause the sign of the error signal 42 to change 
again, and the actuator will be driven in the opposite di- 
rection. Because of the ability of the hysteresis switches 
69 and 65 to almost instantaneously change the sign of 
their output, the actuator will oscillate within an accept- 
able zone about the desired steady state location (i.e., 
a limit cycle). The disturbance estimator and controller 
of the invention can maintain this limit cycle at very small 
values. 



In many feedback control systems, especially actu- 
ators, there will always exist a certain minimum amount 
of friction. The friction forces may be greater than this 
minimum amount, but they will never be less. Because 

5 this minimal amount of friction needs to be overcome 
every time the actuator moves, it is desirable to provide 
acounterforce to overcome this minimum amount of fric- 
tion as quickly as possible. The hysteresis switch 65 pro- 
vides this immediate counterforce. Depending on 

10 whether the sign of the error signal is positive or nega- 
tive, the hysteresis switch 65 outputs a positive or neg- 
ative constant current signal 66 to overcome the mini- 
mum amount of friction. The minimum amount of friction 
that is always present in the system is determined 

*5 through experimentation. It must be noted that the out- 
puts of the hysteresis switches 65 and 69 are always 
constant for any given feedback system. 

As stated above, often the friction forces acting on 
the system are greater than the minimum amount known 

20 io be always present. Accordingly, the inventbn also us- 
es the hysteresis switch 69 in conjunction with the dis- 
turbance integrator 72 to provide the remaining force 
component necessary to overcome the friction forces 
actually present in the system. 

2S The error signal on line 42 is connected as an input 
to the hysteresis switch 69. Similar to hysteresis switch 
65, hysteresis switch 69 outputs a positive or negative 
constant current 62, depending on whether the sign of 
the error signal 42 is positive or negative. The output 62 

30 of the hysteresis switch 69 is used as the input of the 
integrator 72. The output of the integrator 72 is a current 
ramp 73 that, when added to the constant current pro- 
duced by the hysteresis switch 65, provides sufficient 
current, i.e., force, to push the actuator as quickly as 

35 possible through the friction actually present in the sys- 
tem. 

The output 62 of the hysteresis switch 69 is con- 
nected as an input to the integrator 72 to reduce the time 
necessary for the integrator 72 to produce the amount 

40 of current needed to overcome friction. The integrator 
rate must be low enough to avoid oscillations caused by 
current control mode changes, yet high enough to avoid 
dropping the small signal bandwidth. In addition, the in- 
tegrator rate must be less than the value which would 

45 cause current driver saturation mode oscillation. 

By using a hysteresis switch output as the input into 
the integrator, rather than the error signal 42. the inte- 
grator 72 can integrate at a constant fast rate even if the 
magnitude of the error signal is very small which allows 

so maintenance of small signal bandwidth. For example, if 
the input of the integrator was the error signal, and the 
error signal was small at the time the actuator needed 
to overcome a large friction force, it would take the in- 
tegrator a long time to produce the amount of force 

55 needed to push through the friction. By using the hys- 
teresis switch 69, however, the integrator 72 can always 
be integrated quickly, regardless of the magnitude of the 
error signal. 
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In certain applications, e.g., the GS10 or GS25 ac- 
tuators manufactured by the Woodward Governor Com- 
pany of Rockford, Illinois, the maximum rate of integra- 
tion must be kept below a certain limit to avoid adverse 
effects such as voltage saturation and bandwidth loss. 
In these actuators, the maximum rate of integration is a 
function of actuator inductance. The higher the induct- 
ance, the lower the maximum rate of integration needs 
to be. Otherwise, the actuators will suffer from voltage 
saturation. In other actuators or applications, however, 
it may be unnecessary to limit the maximum rate of in- 
tegration. 

The constant force component 66, generated by the 
hysteresis switch 65, and the ramp force component 73, 
generated by the integrator 72 and the hysteresis switch 
69, are added to the compensator signal 31 at summa- 
tion point 79 to obtain the control signal 32 which is input 
to the actuator 55. Because the ramp force component 
73 will continue to increase in the desired direction, the 
control signal 32 will eventually have too much current 
and cause the actuator to slightly overshoot the desired 
steady state location. 

. Once the actuator passes the desired steady state 
location, the sign of the error signal 42 changes. At that 
time, the sign of the output of the hysteresis switches 
65 and 69 also change. Consequently, the constant 
force component 66 and the ramp force 73 will be ex- 
erted in the opposite direction as before. Once again, 
the magnitude of the ramp force 73 will continue to in- 
crease until the actuator has slightly overshot the de- 
sired location. At that time, the force components 66 and 
73 will change direction again. 

The actuator oscillation about a desired location will 
continue indefinitely in a limited band sometimes char- 
acterized by the term limit cycle. Because of the hyster- 
esis switch ability to almost instantaneously change the 
direction of their output current, however, the actuator 
will be able to have a small to negligible limit cycle. 

The ramp force 73 also has the added benefit of 
compensating for any offsets that may be present in the 
system. Offsets are errors present in the system due to 
changes in gain, static state forces, or other causes. The 
effect of offsets is that the system will need more current 
than the system model predicts it needs. Therefore, the 
compensator signal 31 will not be adequate to drive the 
actuator (if one were to ignore the effects of friction). The 
ramp force 73 is capable of providing this extra current 
without adversely affecting system performance. If there 
is an offset error present in the system, the sign of the 
error signal 42 will not change until the offset error has 
been overcome. 

Referring to FIG. 6, the performance of the distur- 
bance estimator and controller according to the inven- 
tion can be improved by incorporating certain linear el- 
ements to complement the described nonlinear design. 
FIG. 6 depicts the invention according to FIG. 5 with two 
additional linear elements. The two additional linear el- 
ements allow the estimator and controller to compen- 



sate for very large error signals that are not necessarily 
due to disturbances, e.g., when the actuator is com- 
manded to go from one extreme position to another ex- 
treme position. 
s It will be seen that FIG. 6 is similar to FIG. 5, and 
that similar components are located in similar positions. 
The gain blocks in FIG. 6 however include not only the 
general designator K (with its appropriate subscript), but 
also the factors which go to make up that gain. One 
10 skilled in the art will appreciate by the detailed notation 
of the factors within each of the gain blocks how one 
goes about determining the particular gains in a partic- 
ular system. It will be seen, as described in general 
above, and with the gains thus defined as in FIG. 6, one 
is skilled in the art will be able to configure a control system 
as described and claimed herein. 

With respect to the differences between the pre- 
ferred system of FIG. 6 and the FIG. 5 implementation, 
a linear signal component 68 is added to the input of the 
20 integrator 72. The error signal 42 is multiplied by the 
gains K e1 and K d to produce a signal 68. The signal 68 
is added to the output 62 of the hysteresis switch 69 at 
summation point 70 to obtain the signal 71 , which is in- 
put to the integrator 72. 
25 The gain K e1 is the same as was described in con- 
nection with FIG. 5. Kd is determined by state space or 
classical techniques that are well known to those with 
ordinary skill in the art. When the error signal is small, 
the signal 68 will not contribute significantly to the rate 
30 of integration of the integrator 72 because the output of 
the hyste resis switch 69 will be much larger than the sig- 
nal 68. When the error signal is large, however, the sig- 
nal 68 will help the integrator 72 to integrate faster. 
The second modification from the FIG. 5 implemen- 
35 tation is the addition of a third force component on line 
67 to the output 73 of the integrator 72. The third force 
component on line 67 is a linear force and is generated 
by multiplying the error signal 42 by gains K»2 ar| d 
The gains K e2 and K d are the same as described earlier. 
40 The third force component on line 67 will be small and 
not very significant when the error signal 42 is small. 
When the error signal 42 is large, however, the third 
force component will help to push the actuator to the 
desired location. The constants K e2 and K d are deter- 
45 mined such that the sum of the first force component 
and the third force component is less than the actual 
disturbance present in the system. 

The third force component 67 is added to the output 
73 of the integrator 72 at summation point 75 to generate 
so the signal 77. It is this new signal 77 that is added to the 
constant force component 66 and the compensator sig- 
nal 31 at summation point 79 to generate the control sig- 
nal 32. Alternatively, the third force component can be 
added to the first force component 66, the second force 
55 component 73, and the compensator signal 31 directly 
at summation point 79. 

By adding the two linear elements represented by the 
linear signal 68 and the third force component 67, the 
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disturbance estimator and controller of the invention can 
better respond to a wide range of error signal magni- 
tudes. The hysteresis switches 69 and 65 enable the 
invention to rapidly overcome friction forces when the 
error signal is very small (e.g., when the actuator is 
maintaining a small limit cycle about a desired steady 
state location), and the linear signals 67 and 63 allow 
the invention to rapidly reduce a very large error signal 
(e.g., when the actuator is commanded to move from 
one extreme position to another). 

The implementation of FIG. 6 can be considered a 
basic linear controller on which a non-linear disturbance 
estimator and integrator is overlaid. While the linear 
components might be eliminated, if desirable, they illus- 
trate certain benefits of the invention. For example, 
when a basic controller design originates from linear 
considerations, it is possible to overlay a non-linear dis- 
turbance estimator and controller on those linear ele- 
ments, and have the two operate together. The ele- 
ments can then be separated, when desired, and ana- 
lyzed separately. For example, if trouble shooting is 
needed, it is possible to disable the non-linear distur- 
bance estimator and to revert to the linear control for 
debugging purposes. When the control is appropriately 
debugged, the non-linear disturbance estimator and 
controller can be again overlaid to achieve the benefits 
of the invention. The use of the overlaid non-linear com- 
ponents with a very robust and stable linear controller 
render the development of the controller quite easy in 
comparison to the classical approach. The overlay of the 
non-linear disturbance estimator and controller achieve 
more precise operation. And the linear components do 
participate in the overall operation when large move- 
ments are required. The non-linear elements do not al- 
low the control to become slow when the error is small. 
The best of both systems is thereby achieved. 

It will now be apparent that what has been provided 
is a new form of feedback control. A state model is pro- 
vided which can be very simple in construction. A basic 
controller, which can be linear if desired, drives both the 
plant (the actuator) and the state model. An output of 
the state model is compared with a corresponding feed- 
back signal from the plant to generate an error signal. 
The error signal is sensed by the disturbance estimator 
to actuate a disturbance controller in the presence of a 
disturbance to impose a non-linear correction on the 
system to accommodate tor the disturbance. The con- 
trol is relatively simple in design yet produces highly de- 
sirable control characteristics. 



Claims 

1. A control system for a plant subject to non-linear 
disturbances, comprising: 

a controller responsive to an external command 
signal and a first feedback control signal for 
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generating a first controller output signal; 
a model responsive to said first controller out- 
put signal for emulating plant response to said 
first controller output signal, said model gener- 

5 ating said first feedback signal indicative of 

plant response as a result thereof; 
first means for comparing actual plant response 
with said first feedback signal, said first means 
generating said first error signal thereby; 

10 a disturbance estimator responsive to said first 

error signal for generating a first output com- 
pensation signal calculated to approximate the 
correction for non-linear disturbances; and 
second means for summing said first controller 

is output signal and said first output compensa- 

tion signal, said second means generating a 
compensated plant command signal for driving 
the plant in accordance therewith. 

20 2. The system of claim 1, further comprising a third 
means for scaling said first controller output signal 
prior to said summation performed by said second 
means. 

25 3. The system of claim 1 , wherein said model adjusts 
said first feedback signal in response to said first 
error signal. 

4. The system of claim 1 , wherein said model compris- 
30 es a state model of the plant. 

5. The system of claim 1 , wherein said disturbance es- 
timator comprises a first hysteresis switch config- 
ured to input said first error signal, said first hyster- 

35 esis switch generating a disturbance control signal 
of a predetermined magnitude in response to a po- 
larity of said first error signal. 

6. The system of claim 5, wherein said first hysteresis 
40 switch changes a polarity of said disturbance con- 
trol signal in response to a change in said polarity 
of said first error signal. 

7. The system of claim 5, wherein said predetermined 
45 magnitude of said disturbance control signal is in- 
dependent of a magnitude of said first error signal. 

8. The system of claim 5, wherein said predetermined 
magnitude of said disturbance control signal is in- 

50 sufficient to overcome effects of the non-linear dis- 
turbances. 

9. The system of claim 5, wherein said disturbance es- 
timator further comprises a second hysteresis 

55 switch configured to input said first error signal, said 
second hysteresis switch generating an output sig- 
nal in response to a polarity of said first error signal, 
a first integrator responsive to said output signal for 
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generating a ramp signal, and summation means 
responsive to said disturbance control signal and 
said ramp signal for producing said first output com- 
pensation signal. 

s 

10. The system of claim 9, wherein said second hyster- 
esis switch changes a polarity of said output signal 
in response to a change in said polarity of said first 
error signal. 

10 

1 1 . The system of claim 9, wherein said ramp signal has 
a predetermined slope. 

12. A method of controlling a plant subject to non-linear 
disturbances, comprising the steps of: 

generating a plant control command; 
modeling a state of the plant in response to said 
plant control command; 

adjusting said plant control command in re- 20 
sponse to said modeled state of the plant; 
commanding a state of the plant with said ad- 
justed plant control command; 
comparing said state of the plant with said mod- 
eled state of the plant to generate an error sig- 25 
nal; 

calculating an estimated disturbance compen- 
sation signal in response to said error signal; 
adjusting said adjusted plant control command 
in response to said estimated disturbance com- 30 
pensation signal. 

1 3. The method of claim 1 2, further comprising the step 
of modeling a state of the plant in response to said 
adjusted plant control signal and in response to said 35 
error signal. 

14. The method of claim 12, wherein said step of cal- 
culating an estimated disturbance compensation 
signal in response to said error signal comprises the *o 
steps of: 

generating a disturbance control signal of a pre- 
determined magnitude and an output signal in 
response to a polarity of said error signal; 
integrating said output signal to generate a 
ramp signal; and 

summing said disturbance control signal and 
said ramp signal to generate said estimated 
disturbance control signal. so 

15. The method of claim 14, wherein said step of gen- 
erating a disturbance control signal of a predeter- 
mined magnitude and an output signal in response 

to a polarity of said error signal further comprises ss 
the step of changing a polarity of said disturbance 
control signal and said output signal in response to 
a change in said polarity of said error signal. 



16. The method of claim 1 2, wherein said step of mod- 
eling a state of the plant in response to said plant 
control command comprises the steps of: 

integrating said adjusted plant control com- 
mand to produce a derivative estimate of said 
state of the plant; 

adjusting said derivative estimate of said state 
of the plant in response to said error signal; and 
integrating said adjusted derivative estimate of 
said state of the plant to produce said modeled 
state of the plant. 

17. An actuator positioning control system for a plant 
subject to non-linear frictiona! disturbances, com- 
prising: 

a controller responsive to an external position 
command signal and a first feedback control 
signal for generating a first controller output sig- 
nal; 

a state model responsive to said first controller 
output signal for emulating actuator response 
in the absence of non-linear frictional forces to 
said first controller output signal, said state 
model generating said first feedback signal in- 
dicative of a modeled actuator state as a result 
thereof; 

first means for comparing actual actuator re- 
sponse to said first controller output signal with 
said first feedback signal, said firstmeans gen- 
erating said first error signal thereby; 
a non-linear disturbance estimator responsive 
to said first error signal for generating a first out- 
put compensation signal calculated to compen- 
sate for the non-linear frictional disturbances; 
and 

second means for summing said first controller 
output signal and said first output compensa- 
tion signal, said second means generating a 
compensated actuator command signal for 
driving the actuator in accordance therewith. 

18. The system of claim 17, wherein said state model 
further emulates actuator response to said first con- 
troller output signal in the presence of non-linear 
frictional forces, said state model being responsive 
to said first error signal thereby and adjusting said 
first feedback signal in response thereto. 

19. The system of claim 17, wherein said state model 
comprises a second order state model of the actu- 
ator. 

20. The system of claim 17, wherein said disturbance 
estimator comprises a first hysteresis switch config- 
ured to input said first error signal, said first hyster- 
esis switch generating a disturbance control signal 
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of a predetermined magnitude in response to a po- 
larity of said first error signal. 



21 . The system of claim 20, wherein said first hysteresis 
switch changes a polarity of said disturbance con- s 
trol signal in response to a change in said polarity 
of said first error signal. 



22. The system of claim 20, wherein said predeter- 
mined magnitude of said disturbance control signal io 
is independent of a magnitude of said first error sig- 
nal. 

23. The system of claim 20, wherein said predeter- 
mined magnitude of said disturbance control signal is 
is calculated to be less than a known force needed 

to overcome effects of the non-linear frictional dis- 
turbances. 



24. The system of claim 20, wherein said disturbance 20 
estimator further comprises a second hysteresis 
switch configured to input said first error signal, said 
second hysteresis switch generating an output sig- 
nal in response to a polarity of said first error signal, 

a first integrator responsive to said output signal for 25 
generating a ramp signal, and summation means 
responsive to said disturbance control signal and 
said ramp signal for producing said first output com- 
pensation signal. 

30 

25. The system of claim 24, wherein said second hys- 
teresis switch changes a polarity of said output sig- 
nal in response to a change in said polarity of said 
first error signal. 

35 

26. The system of claim 24, wherein said ramp signal 
has a predetermined slope. 
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ple state model representative of the controlled plant is 
provided. A plant controller responds to a command sig- 
nal and a process feedback signal for producing a con- 
troller output. The controller output drives both the plant 
and the state model. A sensed signal representing a 
state of the plant is compared with a corresponding out- 
put state of the model to produce an error signal which 
is representative of disturbances applied to the system. 



The disturbance estimator and controller responds to 
the error signal to produce a disturbance control output 
which is adapted to compensate for the non-linear dis- 
turbance. In a preferred embodiment the plant is an ac- 
tuator and the non-linear disturbances are friction relat- 
ed. The disturbance control output in the preferred em- 
bodiment has an initial constant magnitude summed 
with an increasing ramp, and the disturbance estimator 
senses polarity reversals in the error signal to reverse 
the polarity of at least the constant component of the 
disturbance output. 
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